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I. General Information 


FIRDCDUW is the interface routine between the various powered flite 
guidance programs and the digital autopilot. (The "W" in FINDCDUW stands 
for window control, and distinguishes the present routine from the old 
FIEDCDUD Routine which was never used in the window control mode and still 
exists, along with FIRDCDUW, in Program SlUTDAECE. ) FIEDCDUW receives from 
the guidance programs thrust and window pointing commands and provides the 
autopilot with gimbal angle increments, commanded attitude rates, and com- 
manded attitude lag angles (which account for the angles by which the body 
will lag behind a ramp command in attitude angle, due to the finite angular 
accelerations available). FIEDCDUW (^SneJ)the estimated thrust vector with 
the unit thrust command vector, and, when in the automatic X axis control 
mode, ^aJi ne^ the +Z half of the LM ZX plane with the window command vector. 

FIMDCDUW is designed to the following objectives: 

1. To produce the normal, small angle, maneuvers determined by the 
guidance inputs at essentially constant attitude rate, reaching 
the terminal attitude at the completion of the two second com- 
putation period. 



2. To produce the gross maneuvers, which are required at the boun- 
daries between guidance phases or upon about, with a continuous, 
rate-limited attitude profile extending over whatever time duration 
is required to complete the maneuver. 
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3- To avoid excessive middle gimbal angle in all maneuvers^ never 
reaching the critical middle gimbal angle during a maneuver in 
which the terminal middle gimbal angle is less in magnitude than 
the critical value; to display an alarm code when inputs to 
FINDCDUW determine a terminal middle gimbal angle in excess of 
the critical value, and to limit the middle gimbal excursion 
at the critical value. 

4. To permit manual X axis control when the flag FLAUTOX is 0, not 
interfering when this control is being exercised, not drifting 
about the X axis when manual control is permitted but not 
exercised. 

5. To provide identical interfaces except with alternate rate 
limit values when the Command and Service Modules are docked. 

The concept of FIM)CDUW is a departure from previous concepts for 

performing this interface function which is computationally more direct and 

automatically produces maneuvers which avoid excessive middle gimbal angle. 

The concept of FIKDCDUW is as follows. The thrust and window pointing commands, 

and the location of the thrust vector relative to spacecraft axes, determine 

a required, or terminal, spacecraft attitude. The gimbal angles corresponding 

to this terminal attitude are computed, and inputs to the autopilot are 

generated which drive each gimbal angle directly from its initial value to 

* 

its terminal value. Provided the attitude is not initially in gimbal lock, 
and provided the input commands do not yield a terminal attitude in gimbal 
lock, it is impossible to pass through gimbal lock d-uring the maneuver since 
the middle gimbal angle is confined to tie range between its initial and ter- 
minal values. Other schemes for gimbal lock avoidance produce similar man- 
euvers, but are computationally less direct. 

Control of spacecraft attitude by this gimbal-drive process is illus- 
trated in Figure 1 and described as follows. Two fictitious coordinate 

* Except the outer gimbal angle profile may not be monotonic in the geo- 
metrically complex case of a large maneuver about multiple axes at sub- 
stantial middle gimbal angle and with magnitude limiting of the X axis 
attitude angle change on at least one pass thru FINDCDUW. 
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frames are defined. The firsts called the current vehicle frame, is computed 
using the desired gimbal angles, CDUB's, maintained by the digital autopilot. 
The unit vectors of the current vehicle frame would be identically the body 
unit vectors if the desired gimbal angles were identically the actual gimbal 
angles. The thrust direction filter is processed in the currect vehicle 
frame to yield the iinit thrust vector in vehicle coordinates second 

frame, called the coimanded vehicle frame, is computed using "the unit 

thrust command QJ^d the unit window command Commanded gimbal angles, 

CDUC's, are computed using the unit vectors of the commanded vehicle frame. 

The commanded middle gimbal angle is magnitude limited, and an alarnn code is 
displayed if limiting changed the value. Unlimited gimbal angle changes are 
computed as the differences between the commanded and the desired gimbal 
angles. The unlimited gimbal angle changes are transformed to yield attitude 
angle changes, then limited according to whether the CSM is docked. The 
X axis attitude change is set to zero if X axis override is permitted or if 
the unit thrust and unit window commands are to nearly parallel or anti- 
parallel or if the Y axis or Z axis imlimited gimbal angle change exceeds 
45° in magnitude. The resulting attitude angle changes are transformed 
back to yield the gimbal angle changes. The gimbal angle changes are multi- 
plied by the ratio of the autopilot control sample period 6T to the compu- 
tation period 1^*, to yield the gimbal angle increments, which constitute 
the angle interface with the autopilot. The autopilot adds the gimbal angle 
increments to the CDUD's each control sample period so that (provided none 
of the preceding limiting changed any value, normally it does not) the CDUU's 
are driven to equality with the CDUC's during the succeeding computation 
period. The digital autopilot closes a control loop between the CDUD's and 
the measured gimbal angles, CDU's, using, in addition to gimbal angle errors 
which it computes, the commanded attitude rates and lag angles supplied by 
FIM)CDUW. 

Throughout this Luminary memo 6 denotes "increments" of the associated 

variable which are to occur each control sample period of the digital auto- 
pilot, 0.1 second, whereas A denotes "changes" of the associated variable 
which are to occur each computation period, 2 seconds. 
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It is important that in computing the gimbal angle changes, no 
reference is ever made to the measured gimbal angles, CDU’s. If the CDU's 
were used as the basis of comparison, one could expect stability problems 
due to feeding back attitude motion due to fuel slosh at the computation 
frequency. FIIJDCDUW avoids all reference to the measured spacecraft attitude 
(except in one case, which will be dealt with in the next section) and still 
produces zero steady, state thrust direction error. 




5 
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II. Computations 

The description of this section follows Figure 2. Prior to engine 
ignition for each of the major mission modes, the thrust direction filter 
and the unit window command are initialized. The thrust direction filter 
must be initialized for each burn because there is not necessarily any rela- 
tionship between the terminal thrust offset of one burn and the initial 
thrust offset of the 'succeeding burn. For computational efficiency, all 
components of the unit thrust vector in vehicle coordinates, are ini- 
tialized even though the X component is never used; the same unit X 

vector is used to initialize the unit window command u^^p. The unit window 
command must be initialized because there is no requirement for this vector 
to supplied by guidance when X axis override is allowed, and FINDCDUW takes 
its unit which could be disastrous if its contents were random. 

The initialization which must be done each pass thru FINDCDUW amounts 
to acquisition and preparation of constants and input data. These are: 

1. 9^, 9^, 9^^^, the maximum angular changes, are selected depending 
upon whether or not the Command and Service Modules are docked, 

2. FLA.GOODW is initialized to 0 or 1 according to whether X axis 
override is permitted or inhibited. This flag indicates whether 
the xmit window command is good for control about the X axis. 

3* OVFIND, the interpretive overflow indicator, is set to zero. 

4. lixYDP — ZVDP^ ^ ^ axes of the commanded vehicle frame, 

are initialized to the unit thrust command and the unit window 

command If unitizing either of these input command vectors 

fails either because a vector is too short or too long, the inputs 
are presumed \msatisfactory for attitude control, attitude motion 
is stopped, alarm 00402 is issued, and FINDCDUW returns to the 
calling program. 
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5* velocity increment vector measured by the acceler- 

ometers over the previous computation period^ is unitized for 
the thrust direction filter. If this produces overflow, the 
thrust direction filter is bypassed. 

As the first step in the thrust direction filter, unit 

measured thrust in platform coordinates, is transformed to current vehicle 
coordinates to yield the unit measured thrust Then each of the two 

components Y and Z of the old unit thrust vector is subtracted first 
the corresponding component of the unit measured thrust, multiplied by the 
filter gain, and limited in magnitude to the maximum change which can be 
expected in one computation period, which yields the thrust direction 
changes Au^^ and 

of the trim gimbal. Each of these thrust direction changes is then added 
to the corresponding component of the old unit thrust vector and limited 
in magnitude to the maximum thrust offset which can be expected, yielding 
the new unit thrust vector The maximum thrust offset is based on 

the maximum displacement of the trim gimbal, the elastic deflection of the 
gimbal mount, the mounting alinement error, and the deflection of the thrust 
vector relative to the nozzle centerline. This completes the thrust direction 
filter, it is not necessary to take the unit of the resulting vector. 

In order to compute the axes of the commanded vehicle frame, it is 
first necessary to select a suitable unit window command. The unit window 
command obtained from guidance may not be suitable because l) X axis over- 
ride may be permitted or 2) it may fail the test PAELTEST (a test for 
parallelism of anti-parallelism to the unit thrust command). If the unit 
window command cannot be used for either reason, it is necessary to fetch 
an alternate such that the resulting axes of the commanded vehicle frame 
will provide zero steady state thrust pointing error. Any vector lying 
in the +Z half of the B1 symmetry plane will satisfy this requirement. 


AUp^. The maximum changes are based on the slew rate 
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Among these, the vector least likely to he parallel or anti-parallel to 
the unit thrust command is the Z axis. However, it is possible during a 
large maneuver that the Z axis also fails PARLTEST, and in this case a 
third alternative, the -X axis, is selected. Because the Z axis and the 
-X axis cannot both be parallel to the unit thrust command, PARLTEST is 
omitted for -X. The Z and -X axes selected are of the body and not the 
vehicle frame, simply to save program and time, as the service routine 
provides the body axes for all users. Using a body axis for window point- 
ing causes no stability problem because any time a body axis is used, 

FLAGOODW is set to zero so that the attitude angle change about the X axis 
will also be set to zero. Thus actual spacecraft motion about the X axis 
produces through FINCDUW no attitude increment command about the X axis 
and greatly diminished commands about the Y and Z axes. 

The commanded vehicle axes are computed in two steps. First an 
orthogonal set is erected with the X axis along the unit thrust command 
and the Y axis normal to the plane of the unit window command and the unit 
thrust command. Then the X axis is displaced relative to this initial 
frame according to the thrust offset. The final Y axis is oriented normal 
to the initial Z axis and the final X axis, and final Z axis is computed 
to complete the right hand orthogonal triad. With the coordinate frame 
erected this way, the unit window command lies out of the ZX plane by 
approximately the thrust offset angle about the Z axis multiplied by the 
sine of the angle between the Z axis and the unit window command. MIT 
simulations indicate that the thrust offset angle about the Z axis during 
the approach phase of the lunar landing is about 3/4 to 1 degree. 

The commanded gimbal angles, CDUC’s, are derived from the matrix 
just computed, whose row vectors are the unit axes of the commanded vehicle 
frame expressed in platform coordinates. This matrix may be derived in terms 
of the sines and cosines of the gimbal angles by starting with the matrix 
whose rows are these unit vectors expressed in commanded vehicle coordinates 
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(the identity matrix) and rotating the row vectors through the negative 
of the outer^ middle, and inner gimbal angles in that order. The result- 
ing matrix may be used to identify the elements of interest of the matrix 
of the preceding paragraph as 

Cq = cos(CDUCZ ) cos(CDUCY) 

= sin(CDUCZ) 

Cg = -cos(CDUCZ) sin(CDUCY) 

= cos(CDUCZ) cos(CDUCX) 

= cos(CDUCZ) sin(CDUCX) 

The subroutine KBSCDUSP extracts the commanded gimbal angles, CDUC, by 
exploiting these relationships. |CDUCZ| is <90", even before limiting. 

The unlimited gimbal angle changes are computed by modular subtracting 
the autopilot's CDUD's from the CDUC's. The modular subtractions yield the 
smallest angialar differences, e.g. 177° - (-178°) == -5°, not + 355 °. If 
either the Y axis or the Z axis unlimited gimbal angle change exceeds 45° 
in magnitude, FLAGOODW is set to zero. This is to prevent false starts in 
attitude about the X axis, as will be explained in the next paragraph, and 
analyzed in the appendix. 

Attitude angle changes, MTT, are handled in a vehicle frame not 
previously described. The X axis of the frame is identical to the X axis 
of the current vehicle frame, the Z axis is along the middle gimbal axis, 
and the Y axis completes the orthogonal right hand triad. Thus this frame 
is the current vehicle frame rotated about the X axis to bring the Z axis 
into alinement with the middle gimbal axis. This frame is chosen for com- 
putational simplicity. The Z axis gimbal angle change ^DUZ is identical 
to the Z axis attitude angle change AATTZ. The unlimited Y axis gimbal 
angle change is multiplied by cos(CDUDZ) to yield the unlimited Y axis 
attitude angle change, this is limited and divided by cos(CDUDZ) to 
yield the limited Y axis gimbal angle change ^DUY. The unlimited X 
axis attitude angle change is 
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computed using the unlimited X and Y axes gimbal angle changes. Note that 
the modular subtraction always produces a result under l80° in magnitude. 

This computation produces the smallest angle total rotation required about 
the X axis, although the validity diminishes as the gimbal angle changes 
become large. Under certain conditions described in the appendix, the X 
axis attitude angle change computed will be of opposite sign compared to 
the succeeding pass. To prevent starting such a maneuver in the wrong 
direction about the X axis, AATTX is set to zero whenever either the Y axis 
or the Z axis unlimited gimbal angle change exceeds a limit value. Finally 
the limited X axis gimbal angle change, /^DUX, is computed using the limited 
attitude angle change, AATTX, and the limited gimbal angle change ACDUY. 

With all limiting completed, it is now possible to compute a consis- 
tent set of input data for the digital autopilot using the ACDU’s. The 
ACDU's are divided by the computation period and the resulting gimbal angle 
rates are transformed to yield the commanded attitude rates The gimbal 

angle changes are multiplied by the ratio of the control sample period to 
the computation period to yield the gimbal angle increments 6CDU. Finally, 
the commanded attitude lag angles which account for the angles by which 
the attitude will lag behind a ramp angular command due to the finite angular 
accelerations available, are computed using the available angular accelera- 
tions a (supplied by the autopilot), and then individually magnitude limited. 
It should be noted that these data fed to the autopilot are consistent only 
at the time they are computed. During the succeeding computation period the 
CDUD*s change at constant rate, the attitude is forced to follow the CDUD's, 
therefore the actual attitude rate is not constant. The attitude rate will 
vary considerably in direction if the middle gimbal angle is large in magni- 
tude, and the attitude rate will vary in magnitude during the computation 
period if the middle gimbal angle changes. The rate and lag angle data 
supplied by FmDCDUW become increasingly obsolete during the succeeding 
computation period. As a worst case example, a maneuver produced by a large 
step change in the inputs to FIUDCDUW resulting in a large total attitude 
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change at a constant middle gimbal angle of 70 ° would entail an inner 
gimbal angle change of over 58 ° in one computation period and a rotation of 
the attitude rate vector through the same angle about the Y stable member 
axis. Thus the con^onent of attitude rate normal to the Y stable member 
axis would be changed almost 100%. With the present FIM)CDUW design, on 
the succeeding pass the rate and lag angle data would be corrected, but 
with constant middle gimbal angle there would be no change in the gimbal 
angle increments fed to the autopilot, provided the inputs to FIWDCDUW 
were unchanged and the maneuver was still at least one computation period 
from completion. Therefore there would be no transient in the actual 
spacecraft attitude rate. 





INITIAUZATION 



Fig. 3 <p 3) 
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COMMANDED GIMBAL ANGLES AND 
GIMBAL ANGLE CHANGES 



COMMANDED GIMBAL ANGLES (NB2CDUSP SUBROUTINE) 
^ i^VDP* iizVDP^ 


COSZ = -7 1 - Cj 

SIN * Cj, COS = COSZ, CALL ARCTRGSP# 

CDUCZ = ANGLE 

SIN =-C2/COSZ, COS = Cq/COSZ, CALL ARCTRGSP 
CDUCY = ANGLE 

SIN =-C7/COSZ. COS = C^/COSZ, CALL ARCTRGSP 
CDUCX = ANGLE 



■ 

UNLIMITED GIMBAL ANGL 

f 

E CHANGES 

ACDUU * CDUC CDUD 

jjjDENOTES MODULAR SUB1 
TP 1 ACDUUY 1 >45°, FLAG 
IK 1 ACDUUZ 1 >45°, FLAG 
— 

PRACTIONS 

OODW = 0 

OODW = 0 


LIMIT ATTITUDE ANGLE CHANGES AND COMPUTE GIMBAL 
ANGLE CHANGES 

ACDUZ » (LIMIT (ACDUUZ) 

ACDUY = ((LIMIT (ACDUUY COS (CDUDZ)))/COS(CDUDZ) 


AATTX = (LIMIT 


?XM> (^CDUUX j5j(-ACDUUY SIN (CDUDZ))) 


-DENOTES MODULAR SUBTRACTION 
M 

IF FLAGOODW = 0, AATTX = 0 
A CDUX = AATTX - ACDUY SIN (CDUDZ) 



*ARCTRGSP IS A SUBROUTINE WHICH COMPUTES AN UNAMBIGUOUS 
ANGLE ANYWHERE IN THE CIRCLE, GIVEN THE SINE AND THE COSINE. 


Fig. 2 (p 6) 
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AUTOPILOT DATA 



RATE^/^ 

1 

COMMANDED ATTITUDE RATES 

^DV = 

■ 1 sin(CDUDZ) 0 

0 cos(CDUDZ) cos(CDUDX) sin(CDUDX) 

0 -cos (CDUDZ) sin(CDUDX) cos(CDUDX)_ 

AC DU/ 2 




GIMBAL ANGLE INCREMENTS AND COMMANDED ATTITUDE LAG ANGLES 


6 CDU = ACDU 



<#.x 

= (UMIT 10°) 

<‘"dxv I 

1 

“dxv 

1 /2“x) 



= (LIMIT 10°) 

<“dyv I 

“dyv 

1 / 20^) 



= (LIMIT 10°) 

<‘"dzv I 

1 “dzv 

1 /2q'2) 



Fig. 2 (p 7) 
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APFEMDIX 


False Starts About the X Axis 


Without the provisions developed here, it is possible to compute an 
unlimited attitude angle change about the X axis on one pass, rotate such 
as to supposedly diminish the value, and find on the succeeding pass that 
it has in fact increased. If the value on one pass is near l80° on one 
side, the value on the succeeding pass might lie near l80° on the opposite 
side, and the spacecraft would be required to reverse direction of rotation 
about the X axis. The criterion developed here prevents issuance of an X 
axis attitude angle change command whenever the value computed on the 
succeeding pass could be of increased magnitude. 

The two equations of this paragraph provide insight, but do not 
yield a satisfying solution because of the time-discrete character of the 
computations. The unlimited attitude angle change about the X axis is 
computed as part of the eq.uation for AATTX on page 6 of Figure 2. For 
the purpose of this derivation, the modular subtraction of a minus can 
be replaced by an addition to yield 

AATTUX = ^DUUX + ^DUUY SIN(CDUDZ). (l) 


Note that the unlimited gimbal angle changes are used. The time derivative 
of the attitude angle change is 


dAATTUX 

dt 


SIN(CDUDZ) + Z^DUUY COS(CDUr)Z) 


dCDUDZ 
dt • 


(2 


The sum of the first two terms on the right is the attitude rate about the 
X axis. This sum is the quantity controlled, and is ordinarily commanded 
in the direction to diminish AATTUX. The difficulty is that the third term 
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on the right is not controlled by the X axis coramand. Therefore it may 
offset and overcome what is done in controlling the first two tenns. 

The solution comes from considering the X axis unlimited attitude 
angle change computed on two passes. The value computed may be either 
positive or negative. To avoid cumbersome nomenclature only the positive 
case will be treated. For this case we wish a criterion to indicate when 
the unlimited' attitude angle change computed on the second pass will be 
less than that computed on the first pass^ assuming gimbal angle increment 
commands are issued to the autopilot on the first pass, and assuming the 
input commands to FIKDCDUW are unchanged on the second pass. The unlimited 
attitude angle changes computed on the two passes are 

AATTUX^ = Z^DUaX^ + ^DUUY^ SIN(CDUDZ^), 

MTTUX^ = ^DUUX^ + ACDUUX^ SIN(CDUDZ2)' 

The change in the computed value is, subtracting (3) from (4) 

AATTUX^ - MTTUX^ = A^DUUX^ - ACDUUX^ 

+ A^DUUYg SIN(CDUDZ2) - ACDXJUY^ SIN(CDUDZ^) . (5) 

But, with the X axis attitude angle change limited, the the equation on 
page 6 of Figure 2 which produced the limiting may be rewritten as 

ACDUX^ + SIW(CDUDZ^) = • (^) 

This is a relationship for the changes which will actually be made to CDUBX 
and CDUDZ by the digital autopilot during the interval between the first and 
second passes thru FIKDCDW. With the commands to FIUDCDUW unchanged on the 
second pass, the unlimited gimbal angle changes computed on the second pass 
will be decremented by the same amounts. That is 


(3) 

( 4 ) 
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ACDUUX^ 

= ZiiCDUUX^ 

- ACDUX^, 

( 7 ) 

^DUUY^ 

= ^DUUY^ 

- AODUY^. 

(8) 


Solving Equations (7) and (8) for ^DUX^ and ACDUY^, substituting into 
Equation (6), and rearranging terms yields 

0 = MDUUX„ - ZNCDUEX^ + (ZiCDUUY^ - ACDXJUY, ) SIN(CDUDZj + 0^.. (9) 

o J. c J. 1 aM. 

Subtracting (9) from (5) yields 


MTTUX^ - AATTUX^ = /^DUUY^ [SIN(CDUDZ2) - SIN(CDUDZ^)] - , (lO) 


which we wish to be negative. Taking the case when ^DUUY^ is positive 
(the negative case yields the same criterion for IZiCDUlTYg I )? CDUEZ^ < 
CDUDZ^, the right side is always negative j but if CDUDZ^ > CDUDZ^ the 
criterion is 


^WUY^ < 


^XM 

SIN(CDUDZ2) - SIN(CDUDZ^) ’ 


( 11 ) 


Because the change in sines is always less than the change in angles, 
it is conservative to replace the sines by the angles. And since Z axis 
gimbal angles and attitude angles are identical, the worst case is when 
the change in the middle gimbal angle is the limit value. In this case 
the criterion becomes 

Iacduuy 1 < . (12) 

^ ^ rn/r 


Taking the absolute value makes the criterion applicable to the cases 
involving other signs of the variables. With 9^ = 9^ the criterion 
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becomes finally 


l/^DUUY^ I < 1 radian , (13) 

Because only ACDUUY^ is available at the time the test is made^ it is 
used instead, which produces a more conservative test. Thus if ACDUUY^ 
is too large in magnitude, the X axis attitude angle change is set to 
zero, and the X axis attitude profile is thereby rendered essentially 
monotonic. 


